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Abstract — This  manuscript  provides  an  approach  to  solve  the 
nonlinear  least  squares  problem  that  arises  in  decentralized 
fusion.  Even  though  almost  all  sensor  noise  can  be  modeled 
as  additive  noise,  the  additive  nature  of  the  measurement  noise 
is  lost  when  the  signal  is  processed  at  the  sensor  node.  The 
proposed  approach  employs  the  unscented  transformation  before 
the  estimation  problem  at  the  central  node  is  posed  as  a 
nonlinear  least  squares  problem.  Numerical  simulations  indicate 
that  the  proposed  unscented  transformation  based  approach 
yields  desired  results. 
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I.  Introduction 

This  manuscript  provides  an  unscented  approach  to  the 
nonlinear  least  squares  problem  that  arises  in  decentralized 
fusion  [1]  where  only  the  processed  signal  is  sent  to  the  central 
node  as  oppose  to  the  raw  measurements.  Due  to  the  signal 
processing  conducted  at  the  sensor  node,  one  might  loose 
the  additive  nature  of  the  measurement  noise.  For  example, 
consider  the  ith  sensor  observations  of  the  following  form 

y;  =  f(x)  +  Vj  (1) 

where  y i  G  5ftm  are  the  measurements,  xG  SR"  are  the  ground 
truth  quantities  (or  parameters)  of  interest,  and  v,  G  3ftm 
indicates  the  additive  measurement  noise.  In  a  decentralized 
approach,  the  measurements  obtained  at  the  sensor  node  are 
first  processed  before  they  are  relayed  to  a  central  processing 
node.  Let  z i  G  W  be  the  processed  signal  that  is  sent  to  the 
central  node  from  the  i*  sensor,  i.e., 

z i  =  hi  (yi)  =  hi  (f(x)  +  Vi)  +  w,  (2) 

where  w,;  G  ft'  indicates  some  additive  noise.  In  general,  the 
nature  of  the  nonlinear  function  hj(-)  can  change  for  each 
sensor.  At  the  central  node,  the  measurements  from  N  sensor 
nodes  are  fused  to  yield  a  superior  estimate  of  the  quantity  of 
interest.  In  least  squares  approach,  the  estimates  are  obtained 
as  the  hypothesized  parameters  that  minimize  the  least  squares 
cost  function, 

x  =  arg  min  J(x)  (3) 

X 

where 

1  N 

•F:x  :  —  X!  fa  ~  ^(X)}T  fa  ~  z*(x)}  (4) 


where  Zi(x)  indicates  the  estimated  processed  signal  for  the 
hypothesized  parameter  x.  Even  though  the  estimation  criteria 
given  in  (4)  can  be  modified  such  that  the  residuals  are 
weighted  to  yield  a  weighted  least  squares  approach  [2],  here 
we  only  consider  the  simple  least  squares.  For  traditional  least 
squares,  the  measurement  is  such  that  the  additive  noise  term 
appears  outside  the  nonlinear  function,  i.e.,  z i  =  hi(f(x))  + 
w,.  Then  the  best  choice  for  the  estimated  processed  signal 
for  hypothesized  x  is 

Z;(x)  =  h, (f(x))  (5) 

Now,  the  minimization  of  (4)  is  equivalent  to  the  calculation 
of  the  maximum  likelihood  (ML)  estimate  of  x,  given  that 
(4)  is  a  weighted  least  squares  cost  function.  For  general 
nonlinear  mappings  h, (■),  there  exists  no  systematic  approach 
to  select  z,  (x).  Once  a  proper  expression  for  the  predicted 
processed  measurement  is  selected  for  the  hypothesized  x, 
one  can  choose  several  traditional  approaches  to  minimize 
(4).  Two  examples  of  these  traditional  approaches  include  the 
zero-order  function  minimization  schemes,  such  as  the  simplex 
algorithm,  and  the  first-order  steepest  decent  approaches,  such 
as  the  iterative  linear  least  squares.  As  presented  in  this  paper, 
the  performance  of  these  approaches  depends  on  the  mappings 
li,  ( - )  and  the  predicted  processed  measurement  expression, 
Zi(x),  selected. 

This  paper  presents  an  unscented  transformation  [3]— [5] 
based  approach  to  the  nonlinear  least  squares  problem  that 
arises  in  decentralized  data  fusion.  The  proposed  approach 
can  be  used  to  improve  the  solution  to  the  nonlinear  least 
squares  problem  in  (4).  Proposed  unscented  transformation 
based  approach  utilizes  the  sigma  points  to  represent  z,  (x) 1 . 
Detailed  formulation  and  analysis  of  the  proposed  approach 
are  presented  in  section  II.  Numerical  simulations  are  given 
in  section  III  to  validate  the  proposed  approach  and  the 
concluding  remarks  are  presented  in  section  IV. 

II.  Proposed  Approach 

For  simplicity  of  presentation,  the  formulation  of  the  pro¬ 
posed  approach  and  the  performance  analysis  in  this  section 
are  described  for  a  one-dimensional  scenario.  Furthermore,  the 
nonlinear  mappings  are  considered  to  be  equivalent  for  each 

'Please  refer  to  Appendix  I  for  a  brief  overview  for  the  unscented 
transformation. 
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sensor.  Overall,  the  mapping  is  h;(-)  =  h  ( ■ ) ,  and  as  a  result, 
Zj(-)  =  z(-).  Consider  an  observation  equation  of  the  form 

V  =  f(x)  +  v  (6) 

It  is  assumed,  the  measurement  noise  is  uncorrelated,  zero- 
mean  Gaussian  noise  with  known  variance,  i.e.,  v  ~  J\f{ 0,  a 2). 
The  sensor  node  processing  can  be  written  as 

5  =  h(f(x)  +v)  +w  (7) 

where  w  ~  A/"(0,  <x2).  Now  the  problem  of  interest  can  be 
formulated  as  a  nonlinear  least  squares  problem  where  the 
cost  function  to  minimize  is 

1  N 

J(x)=  2 (8) 
i=  1 

In  the  cost  function,  Zi  indicates  the  individual  sensor  outputs, 
i.e., 

Zi  =  h  (f(x)  +  Vi)  +  Wi  (9) 


In  a  traditional  approach,  a  zeroth-order  approximation  is  used 
to  obtain  z(x)  as 

z(x)  =  h(f(x))  (10) 


Substituting  (10)  and  (9)  into  (8)  yields  the  cost  function 
1  N 

Mx)  =  2x'52{h{f(x)+Vi)+Wi  -  h(f(x))}2  (11) 

V  i—l 

Let  y  =  f(x),  and  Ay  =  f(x)  —  f(x).  Now  the  above  cost 
function  may  be  written  as 

1  N 

Ji  (x)  =  {h(y  +  Ay  +  vi )  +  wi  -  Hy)}2 

i=  1 

=  j77^2\Ky)  +  h'(y)(Ay  +  vi)  +  ^4 —{Ay  +  Vi)2+ 
h"'(v)  }  2 

-^(Ay  +  Vi)3 +  ...-%)+«*} 

That  is,  in  the  traditional  approach,  the  cost  function  becomes 


Mx)  =  -^r^{wi  +  h\y){Ay  +  vi)  +  ^-^-{Ay  +  vif 

V  i=l  ^ 


h"'{y) ,  .  x3 

+  ^P(A  y  +  Vi)3  +  ... 


(12) 


The  unscented  transformation  based  approach  proposed  here 
uses  the  sigmapoints2  to  approximate  z(x),  i.e., 

z(x)  =  \h(f(x))  +  ^Hf(x)  +  VSov)  +  \h{f{x)  ~  VSov) 

0  0  D 

(13) 


2Please  refer  to  Appendix  I. 


Note  that  here  we  do  not  consider  sigma  points  for  w  since  it 
is  assumed  to  be  a  zero  mean  Gaussian  variable  which  appears 
linearly  in  z.  Substituting  (13)  and  (9)  into  (8)  yields 


1  _  (  2 
Mx)  =  2^  5Z)  Hf(x)+Vi)  +  Wi  -  -h(f(x))- 

i=  1  ^ 

1  1  1  2 

-h(f{x)  +  VSov)  -  —h(f(x)  -  VSov)> 

Using  the  following  Taylor  series  approximations 

h(f(x)  +  Vs av)  =  h(y)  +  h'(y)(VSov)+ 

h"(y)  ,  r-  ,2  h"'(y)  .  r-  ., 

2|  (VSov)  4 - — —  (VSov)  +... 


(14) 


h(f(x)  -  VS crv)  =  h(y)  -  h'(y)(VSav)+ 


h"{y) 

2! 


(Vs> 


2  Fn 

a„r - — — (v3o 


3! 


+  . . . 


yields 


1  N  f 

Mx)  =  2^5^!  h(y)  +V(y)(Ay  +  Vi) 


h"{y) 

2! 


{Ay  +  Vi f 


h'"(y)/A  2 

f  — ^r~(Ay  +  M  +  •  •  •  -  3  Hv) 
Hy)  +  h\y){VSav)  +  h  ^  (Vsav)2 


Hy)  -  h\y){VSav)  +  ^-zp-{VSav)2 


h"'{y) 

3! 


(Vs o 


Thus,  for  the  proposed  approach,  the  cost  function  becomes 


MX)  \  Wi  +  h'V)(AV  +  Vi)  + 

1=1  l 

h'"(y)  .  .3  1 

+  -3!  (Aj/  +  Wi)  +'"_  3 


N 


h"(y) 

2! 

h"(v) 

2! 


(Ay- 


(VSaM 


h'n{v)-(A.r  + 


4! 


6! 


(15) 

The  accuracy  of  the  least  squares  solution  depends  on  which 
approximation  of  z(x)  is  used  in  the  cost  function.  The 
material  presented  in  rest  of  this  section  aims  to  argue  that  the 
unscented  transformation  based  approximation  given  in  (13) 
should  yield  a  superior  solution  when  compared  to  that  of  the 
traditional  approximation  given  in  (10). 

Lemma  1.  For  the  least  squares  problem  given  in  (8),  the 
optimal  z(x)  approaches  E[z\  as  N  — >  00. 

Proof:  The  first  derivative  of  (8)  is  given  by 

dJ  1  \  ^  dz 


dx 


2 


and 


N 


S3:)  =  0  =►  *(*)  =  4e* 


dx 


satisfies  the  necessary  and  the  sufficient  condition  for  optimal¬ 
ity.  Now  based  on  the  law  of  large  numbers  [6],  [7], 


lmi  —  Zi  =  E\z] 

N — »oo  1  J 

i=  1 

Thus  the  optimal  z(x)  asymptotically  approaches  E[z],  i.e., 
lim  z(x)  =  E[z\ 

N — >oo 


N 


h"(y)„ 2  ,  fe(4)fa)3j. 4  |  h{6)(y)  q2j6 


+ 


2!  w 
h{8\y)o3„8 


4! 


h{w){y). 


6! 


o3_s  I  •”  \i’/o4_10 

o  (7  H - 777 — o  (7  +  .  .  . 


E[z]  -  \ \ h(f(x ))  +  i h(f{x )  +  v/3<T-t,)+ 


^(/(*)  ^  V^)}  =  — ^T^(15  -  32)crt6  + 

^(105-3»)^  +  ^(945-3Vi0  +  ... 

Also,  the  difference  between  the  true  expectation  and  the  first- 
order  approximation  can  be  written  as 

h"(y)  _2  ,  h^{y). 

2! 


£0  -  h(f(x))  =^a2  +  —  rr^-3crf 


4! 


15(7,, 


/i(8)(y) 


105(7.®  + 


exact  representation  of  the  true  expectation.  Therefore,  the 
proposed  unscented  transformation  based  approach  better  ap¬ 
proximates  E[z\  for  x  =  x.  Thus,  we  expect  that  the  unscented 
transformation  yields  better  estimates  when  compared  to  the 
traditional  first-order  approximation  based  approach. 

From  lemma  1,  as  N  — >  oo,  the  optimal  solution  that 
minimizes  the  cost  function  in  (14)  is  obtained  when 


There  exists  no  exact  analytical  representation  for  evaluating 
E[h{y)\  for  a  generic  nonlinear  mapping,  h(-).  Following  the 
same  argument  given  in  [8],  it  can  be  shown  that  the  unscented 
transformation  approximation  given  in  (13)  is  more  accurate 
than  the  first-order  approximation  given  in  (10)  when  the 
estimation  errors  are  ignored,  i.e.,  x  =  x.  When  x  x. 
Ay  =  0  and  E[z\  can  be  written  as 

Using  the  Taylor  series  expansion,  the  unscented  transforma¬ 
tion  approximation  can  be  written  as 

| Hf(x ))  +  jjh(f  (x)  +  V3av)  +  i h(f(x )  -  V3av)  = 


(16) 


=  0 


E[z\  -  | ^h(f(x))  +  hi{f{x)  +  V3av) 

+  -  V3cr„)| 

where  x2  denotes  the  x  that  minimizes  (14).  Note 

E[z]  -  \h{f{x2))  -  \h{f{x2)  +  V3 av)  -  \h(f{x2)  -  V3av 
0  0  0 


=h'(y2)E[(Ay2+v)] 

3! 


h"{V2) 


2!  E  [(A2/2  +  v)2  -  al]  + 

E  [(A y2  +  f)3]  +  ^  E  [( Ay 2  +  V)A  ~  3cr»] 


+ 


5! 


E  [(A j/2  + v)5]  +  ■  ■  • , 


where  y2  =  f{x2)  and  A y2  =  f{x)  —  f(x 2).  Since  v  is 
assumed  to  be  zero  mean,  Ay2  can  be  factored  from  the  odd 
terms  in  the  Taylor  series,  i.e., 


h'{y2)E  [(A y2  +  r>)]  =  A y2h'(y2 

h'”{h 


-E  [(Aj/2  +v )3]  =  A y2 


h'"{y2) 


3!  ~  1  ~ >  j  3! 

h{5\y2)  r  ,51  A 

- - - E  [(Ay2  +  v)  J  =  A y2 - 


{Ayl  +  3(7.2} 

4  i  inA.,2  J 


8!  ”  10! 

Now  the  difference  between  the  true  expectation  and  the 
unscented  transformation  approximation  can  be  written  as 


5,  {Ay|  +  lOAyl<jv 
+  15(7t1} 

^-E  [(A»  +  vf]  =  (a»§  +  21A« 


7! 


7! 


+  105Ay^  +  105cr! 


Also  note  that  Ay2  can  be  factored  from  the  first  two  even 
terms  in  the  Taylor  series,  i.e., 

E  [{Ay,  +  vf  -  vf]  =  ^ 

/i(4)  (y2 


4! 


■E  [{Ay 2  +  v)4  -  3(74  = 


2! 

4  o_41  _  h[4\y2)  r  A  2  .  c  21  a„.2 


4! 


-{Ay22+Qal}Ayl 


6!  v  8! 

Note  that  for  the  unscented  transformation,  the  errors  only 
show  up  in  sixth  and  higher-order  terms  in  the  Taylor  series. 
Also,  the  higher-order  errors  are  scaled.  If  the  sixth  and  higher- 
order  even  terms  in  the  Taylor  series  of  h{-)  are  identically 
zero,  then  the  unscented  transformation  approximation  is  an 


Therefore,  if  the  sixth  and  higher-order  even  terms  in  the 
Taylor  series  are  identically  zero,  then  the  optimality  condition 
given  in  (16)  yields  Ay2  =  0.  Now  if  the  mapping  /(•)  is 
assumed  to  be  one  to  one  [9],  then 


Aj/2  =  0 


x2  =  x 


Thus,  the  proposed  approach  asymptotically  yields  unbiased 
estimates  if  the  sixth  and  higher-order  even  terms  in  the  Taylor 
series  of  h(-)  about  y2  are  identically  zero. 


3 


In  general,  the  optimality  condition  given  in  (16)  can  be 
written  in  summation  form  as 


^(Ay2) = j 

k=  1  ^ 

h^2k\y ; 


f  /i(2fc-1}(y2 


(2k  —  1)! 


--E  [(Ay2  +  f) 


2fe-ll 


(2fc)! 


E 


(Ay2+v)W- 


{V3crv} 


Ik 


=  0 
(17) 


Let  Xi  denotes  the  optimal  a;  that  minimizes  (11).  Now  for 
the  optimal  solution  that  minimizes  the  cost  function  in  (11) 
is  obtained  when 


MAyi)  =  Y,\ 

k=  1  ^ 


(2k  —  1)! 

hW(y  i) 


Y-E[(Ay1+v)2k~1]  + 


(2k)\ 


E  [(Aj/i  +  v 


|2fcl 


=  0 

(18) 


where  iji  =  f(x i)  and  Ayi  =  f(x)  —  f(x i).  Both  optimality 
conditions  given  in  (17)  and  (18)  do  not  yield  an  unbiased  so¬ 
lution,  unless  further  constraints  are  placed  on  even  derivatives 
of  h(-),  as  mentioned  earlier,  i.e., 

Ji(0)^0  &  J2(0)^0. 

An  optimality  condition  that  yields  unbiased  estimates  can  be 
written  as 


J*(Ay)=J2\ 

k= 1  ^ 


jhW-Vjy) 

(2k  —  1)! 

hW(y) 

(2  k)\ 


2fe-ll 


E  [(Ay  +  v) 


E  [(Ay  +  v)2k  -  E[v2k] 


(19) 


Note  that  J*( 0)  =  0,  i.e.,  J*(Ay)  has  a  root  at  the  origin. 
Now  subtracting  J*(Ay]  from  J\  (Ay)  yields 


MAy)  J*(Ay)  =  f]  ]f^E[v2k^ 


k=l 

oo 


(2fc)! 


(20) 


<»)! 

Also,  subtracting  J*(Ay)  from  J2(Ay)  yields 


MAy)-T(A = 


£[u2fc]  -  {v^gu} 


2k 


(21) 


Since  the  measurement  noise  i>  is  zero  mean  Gaussian,  the 
first  two  terms  of  the  Taylor  series  in  (21)  vanishes  so  that: 


J2(Ay)-J*(Ay) 


=  E 


k—3 


h^2k\y) 

(2k)\ 


(2k-l)\\- 


{V3}2k 


a; 


(22) 

2k 


Note  that  equations  (20)  and  (21)  can  be  written  as 

J1(Ay)-J*(Ay)=E(z]-h(f(x)) 


J2(Ay)  -  J*(Ay)  =  E[z }  -  | h(f(x ))  -  1 h(f(x )  +  V3<j„) 

-  ^ Hf(x )  -  V3cr«) 

6 

All  terms  in  (22)  are  all  smaller  than  the  corresponding  terms 
in  (20).  Certainly,  as  the  noise  variance  goes  to  zero,  both 
J\  and  J2  are  converging  to  J*  for  all  value  of  Ay.  As 
the  noise  variance  fall  below  unity,  \J* (Ay)  —  J2(Ay)\  < 
\J*(A y)  —  ^7i(Ay)|  because  of  the  first  two  terms  in  (20) 
that  vanish  in  (22)  and  the  magnitude  of  all  terms  in  (22)  are 
less  than  those  in  (20).  Furthermore,  it  is  reasonable  to  expect 
that  for  most  cases,  the  root  of  J2  occurs  closer  to  the  root 
of  J*,  which  happens  to  be  closer  to  zero  than  the  root  of 
J\ .  The  intuition  is  that  J2  is  simply  a  closer  surrogate  to  J* 
than  J\ .  In  short,  A y2  that  satisfies  the  optimality  condition 
(17)  is  less  than  the  Ayi  that  satisfies  the  optimality  condition 
in  (18),  i.e., 

\Ay2\  <  | Az/i | 

Now  we  have 

\f(x)  ~  f(x2)\  < \f(x)  -  f(x!)\  (23) 

In  general,  the  inequality  condition  (23)  does  not  always  imply 
x2  is  more  accurate  than  X\,  i.e., 

\,f(x)-f(x2)\  <  \f(x)  —  f(xi)\  \x-x2\  <  \x  —  x\\  (24) 

The  superiority  of  the  proposed  approach  can  be  obtained 
if  one  assumes  x\  and  x2  are  within  an  interval,  [—<5,  +<5], 
centered  about  x  and  the  function,  /(•),  can  be  linearly 
approximated  in  that  interval. 


Table  I 

Summary  of  Unscented  Least  Squares  Approach 


Signal 

zj  =  h  (f(x)  +  Vj) 

Vj  ~  Af(0,  R),  j  =  1, . . . ,  N 

UT 

yo  =  f  (x) ,  Wo  =  k/ (to  +  k) 

yt  =  f  (x)  ±  [y/ (to  +  k)rJ  ; 

Wi  =  k/{2  (m  +  k)} 

-z,  =  h(y;) 

2m 

z(x)  =  WiZi 

i= 0 

LS 

i  N 

argmin  7(x)  =  —  J3  {z j  -  Z(X)}T  {zi  -  z(x)} 

3  =  1 

A  summary  of  the  proposed  approach  for  an  ?7i-dimensional 
scenario  is  given  in  Table  I.  The  first  step  in  un¬ 
scented  transformation  involves  obtaining  the  2 m  +  1  sigma 
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points,  {y0,  Ti,  •  •  ■  ,y2m},  and  the  corresponding  weights, 
{ Wo ,  W\ , . . . ,  W-irn }  •  The  individual  sigma  points  are  then 
transformed  through  the  nonlinear  function  to  obtain  the 
corresponding  Z,.  Finally,  z(x)  is  obtained  as  the  weighted 
sum  of  the  transformed  sigma  points. 

111.  Numerical  Simulations 

Performance  of  the  unscented  least  squares  approach  is  eval¬ 
uated  through  detailed  numerical  simulations.  Three  different 
simulations  are  presented  here. 

A.  Simulation  I 

For  the  first  simulation,  we  consider  the  following  one¬ 
dimensional  example. 

yj=x  +  Vj,  j  =  1, ...  ,10 
Zj  =  exp  (jf?) 

The  measurement  noise  is  selected  to  be  Vj  ~  A/"(0, 0.3)  and 
the  truth  is  selected  to  be  x  =  0.1/ 7r.  The  cost  function  for 
the  least  squares  is 


J(x)  =  Jjy  ^>2  {exP((^  +  vif)  -  2(x)Y  (25> 

The  problem  is  solved  using  three  different  approaches.  The 
first  two  approaches  use  the  traditional  least  squares  approach, 
i.e.,  z(x)  =  exp(x2).  The  third  approach  uses  the  proposed 
unscented  transformation  based  approach.  In  the  first  ap¬ 
proach,  the  optimization  problem  in  (25)  is  solved  using  the 
Gauss-Newton  method  [10].  The  second  approach  uses  the 
Nelder-Simplex  algorithm  [11],  i.e.,  the  fminsearch  function  in 
Matlab.  The  third  approach  also  uses  the  fminsearch  function 
to  solve  the  optimization  problem  obtained  from  the  proposed 
unscented  transformation  based  scheme. 

Results  obtained  from  100  Monte-Carlo  runs  are  presented 
in  figure  1.  The  estimation  error  presented  in  figure  1(a) 
indicates  that  the  unscented  transformation  based  approach 
(UT)  yields  better  results  when  compared  to  the  traditional  ap¬ 
proach.  Note  that  the  unscented  transformation  based  approach 
exhibits  an  error  floor  of  ss  0.0318  in  figure  1.  This  error 
floor  is  obtained  when  x  =  0  and  it  is  due  to  the  ambiguity 
in  the  nonlinear  least  squares  problem  presented.  Figure  1(a) 
also  indicates  that  the  iterative  least  squares  approach  and 
the  simplex  algorithm  yield  the  same  estimation  error  for  the 
traditional  approach.  The  sensitivity  of  the  cost  function,  or  J, 
to  the  noise  intensity  is  presented  in  figure  1(b).  Clearly,  the 
traditional  cost  function  is  more  sensitive  to  the  noise  intensity 
when  compared  to  the  proposed  approach.  Numerical  values 
for  the  mean  and  standard  deviation  of  the  estimation  error  as 
well  as  the  mean  and  standard  deviation  of  the  minimum  J 
are  given  in  Table  II.  The  table  indicates  that  the  unscented 
approach  is  superior  because  it  produces  a  less  biased  estimate. 
On  the  other  hand,  the  variance  of  the  error  is  comparable  for 
the  two  approaches. 
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(a)  Estimation  Error 


Noise  Variance 

(b)  Noise  Sensitivity  of  Cost 

Figure  1.  Simulation  I:  Estimation  Error  &  Noise  Sensitivity  of  Cost  Function 

Table  II 

Simulation  I:  Monte-Carlo  Results 


Traditional 

Traditional 

Proposed 

Iterative 

fminsearch 

fminsearch 

Mean  En'or 

0.2752 

0.2752 

0.0835 

Error  Stdv 

0.0796 

0.0796 

0.0812 

Mean  Cost 

0.3091 

0.3091 

0.3190 

Cost  Stdv 

0.5509 

0.5509 

0.5462 

B.  Simulation  II 

For  the  second  simulation,  we  consider  the  following  two- 
dimensional  example. 


y  i 

j 

Zi 

Z2 

j 

+ 


VW 


Vi 

vl 


j  =  1, ...  ,20 


The 

V(o, 


measurement 

noise  is  selected 

r  t0  ■ 

0.007 

0 

) 

and  the  truth  is  x  = 

0.023 

0 

0.1 

/ 

0.038 

.te 
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(a)  Estimation  Error 


Figure  3.  Schematic  Representation 
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(b)  Error  Norm 

Figure  2.  Simulation  II:  Estimation  Error  &  Error  Norm 


For  the  second  simulation,  the  results  obtained  from  the 
Monte-Carlo  runs  presented  in  figure  2  indicate  that  the  un¬ 
scented  transformation  based  approach  yields  a  better  estimate 
when  compared  to  the  traditional  approach.  Figure  2  also 
indicates  that  the  iterative  least  squares  approach  and  the 
simplex  algorithm  yield  a  similar  estimation  error  for  the  tra¬ 
ditional  approach.  Again,  the  UT  exhibits  superior  estimation 
performance  due  to  smaller  bias. 


C.  Simulation  III 


The  third  simulation  considers  the  practical  problem  of 
sniper  localization  using  multiple  gunfire  detection  sys¬ 
tems  [12],  [13].  The  shooter  or  the  target  location  and  the  ith 
sensor  location  are  defined  as  T  and  ■S’,,  respectively.  For  sim¬ 


plicity,  the  problem  is  formulated  in  -ft2,  i.e.,  7’  (E  K2  = 


Tx 

Tv. 


and  Si  £  3?2  = 


Si. 

A, 


.  Now  we  define  the  individual  range, 


t'i,  and  bearing,  fa,  between  the  ith  sensor  node  and  the  target 


as 


r<  =  yj (Tx  -  S.lx)2  +  (Ty  -  Sly)2  (26) 

fa  =  arctan  2  (Tv  -  Siy ,  Tx  -  Six )  (27) 


Figure  3  illustrates  the  geometry  of  the  shockwave  and  the 


muzzle  blast  for  the  ith  sensor  node  when  the  orientation  of 
the  bullet  trajectory  is  uj  with  respect  to  the  horizontal  axis. 
Here  the  angle  fa  indicate  the  direction  of  arrival  (DOA)  of 
the  muzzle  blast,  ipi  indicate  the  DOA  of  the  shockwave,  and 
the  shockwave  cone  angle  9  is  defined  as 


9  =  arcsin 


(28) 


where  m  is  the  Mach  number.  The  Mach  number  is  assumed  to 
be  known  since  the  typical  value  for  Mach  number  is  m  =  2. 
For  more  detailed  description  of  the  scenario,  please  refer  to 
[12].  Now  the  DOA  angle  for  the  shockwave  can  be  written 
as 

f  — —  9  uj  ,  if  7 t  to  <  (f>i  <  — t]  —  9  T  uj] 

^  I  7^  -\-  9  (jj ,  if  ^  9  -\-  UJ  <L  (j)i  Tt  id . 

(29) 


The  first  case  tt  +  u  <  fa  <  —  j  —  9  +  uj  corresponds  to  the 
scenario  where  the  sensor  is  located  above  the  bullet  trajectory 
and  the  third  case  f  +  9  +  u>  <  fa  <  7r  +  a;  corresponds 
to  the  scenario  where  the  sensor  is  located  below  the  bullet 
trajectory.  The  second  case  fa  =  n  +  u  corresponds  to  the 
scenario  when  the  sensor  is  located  on  the  bullet  trajectory, 
and  such  a  scenario  is  not  considered  here. 

Under  the  assumptions  that  the  bullet  maintains  a  constant 
velocity  over  its  trajectory,  the  time  difference  between  the 
shockwave  and  the  muzzle  blast  can  be  written  as  [14],  [15] 

Ti  =  ^  [1  -  cos \fa  -  Wi\\  (30) 

When  the  sensor  node  is  within  the  field  of  view  (FOV)  of  the 
shockwave,  the  three  available  measurements  are  the  two  DOA 
angles  and  the  time  difference  of  arrival  (TDOA)  between  the 
muzzle  blast  and  the  shockwave,  i.e., 


fa  =  h±  (T,  Si,  oj)  +  7/0  (31) 

fa  =  h2  (T,  Si,  u>)  +  r]v  (32) 

Ti  =  hz(T,Si,u)  +r]T  (33) 


where  hi(-)  is  given  in  (27),  /12O)  is  given  in  (29)  and 
h:i  ( ■ )  is  given  in  (30).  The  measurement  noise  is  assumed 
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to  be  zero  mean  Gaussian  white  noise,  i.e.,  77^  ~  Af(0,a^), 
r]v  ~  Af(0,a^),  and  ifr  ~  A/"(0,  of).  After  obtaining  the 
measurements  at  each  sensors,  the  sensor  range  and  bearing 
to  the  target  it  calculated  as  follows: 


^1  —  'f'l 


CTi 


1  —  cos 


V? i 


(34) 

(35) 


Individual  bearing  and  range  information  is  then  relayed  to  the 
central  node  where  it  is  fused  along  with  the  sensor  locations 
to  yield  an  accurate  sensor  location.  These  information  sources 
are  related  to  the  unknown  parameters  T  and  w  by  a  nonlinear 
transformation  that  changes  for  each  sensor  due  the  changes 
in  the  sensor  location  (see  (31)-(33)).  In  fact  for  range,  the 
angular  measurement  errors  falls  inside  the  nonlinear  function 
in  (35).  For  numerical  simulation  presented  here,  we  consider 
the  scenario  presented  in  figure  4.  Measurement  noise  models 


T  , 
5«r 


- Bullet  Trajectory 

^  Shooter  Location 
•  Sensor  Locations 

- Shock  Angle 

-  Shock  FOV 


Figure  4.  Simulation  Scenario 


are  selected  as  cr^  =  av  =  4°  and  oy  =  1msec. 

Figures  5(a)  and  (b)  show  the  individual  sensor  estimates 
of  the  shooter  location  as  well  as  the  fused  estimates  and 
the  corresponding  error  ellipses  for  both  the  traditional  and 
the  unscented  transformation  approaches.  Note  that  for  both 
approaches,  the  fusion  algorithm  provides  an  estimate  that  is 
superior  to  the  individual  sensor  estimates.  Also,  note  that  the 
fused  estimate  obtained  from  the  proposed  approach  is  closer 
to  the  truth.  Numerical  values  for  the  true  shooter  location  as 
well  as  the  estimated  locations  obtained  from  both  approaches 
and  the  corresponding  root-mean-square-error  (RMSE)  are 
given  in  Table  III.  For  this  scenario,  the  UT  again  provides 
an  estimate  with  smaller  bias  than  the  traditional  approach. 
In  fact,  the  error  ellipse  for  the  UT  approach  is  smaller  than 
that  of  the  traditional  approach.  Unlike  the  prior  scenarios, 
the  performance  improvement  from  the  UT  can  be  attributed 
to  both  reduction  in  the  bias  and  standard  deviation  of  the 
error. 


X 


(a)  Traditional  Least  Squares 


x 


(b)  Unscented  Least  Squares 

Figure  5.  Simulation  III:  Estimation  Error  Ellipse  from  Monte-Carlo  Runs 


Table  III 

Simulation  III:  Monte-Carlo  Results 


X 

y 

Truth 

50 

50 

Trad.  Fused 

39.7429 

50.1127 

UT.  Fused 

58.5026 

50.9283 

Trad.  RMSE 

49.1189 

5.8610 

UT.  RMSE 

37.7813 

5.4535 

IV.  Conclusion 

This  manuscript  provides  an  unscented  approach  to  the  non¬ 
linear  least  squares  problem  that  arises  in  decentralized  fusion. 
In  decentralized  fusion,  measurements  are  first  processed  at 
the  sensor  node  before  they  are  relayed  to  the  central  node. 
Due  to  the  signal  processing  conducted  at  the  sensor  node, 
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one  might  lose  the  additive  nature  of  the  measurement  noise. 
The  proposed  unscented  transformation  based  approach  helps 
to  tackle  the  non-additive  nature  of  the  noise  in  the  nonlinear 
least  squares  problem.  Utilizing  the  information  regarding  the 
noise  characteristic,  the  proposed  approach  yields  superior 
estimates  when  compared  to  results  obtained  from  the  tra¬ 
ditional  least  squares  approach.  Simulation  results  presented 
here  indicate  that  unitizing  the  unscented  transformation  helps 
to  alleviate  the  cost  sensitivity  to  the  measurement  noise.  Also, 
the  unscented  transformation  helps  to  move  the  minimum 
cost  corresponding  to  the  optimal  solution  toward  the  cost 
associated  with  the  zero  estimation  error  and  thus  improves 
the  estimates. 
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Appendix  I 

The  unscented  transformation  is  a  method  for  approximat¬ 
ing,  in  a  computationally  efficient  manner,  the  statistics  of 
a  random  variable  that  undergoes  a  nonlinear  transformation. 
The  basic  principle  behind  unscented  transformation  is  that 
it  is  easier  to  approximate  a  probability  distribution  than  an 
arbitrary  nonlinear  function  [8].  Consider  an  n-dimensional 
random  variable,  x,  with  mean  x  and  covariance  Px.  A  second 
random  variable  y  is  related  to  x  through  the  nonlinear 
function 

y  =  h(x) 

To  calculate  the  statistics  of  the  y  using  the  unscented  trans¬ 
form,  we  proceed  as  follows:  First,  a  set  of  2 n  +  1  weighted 
samples  or  sigma  points  Si  =  {Wi,  X  i]  are  deterministically 
chosen  so  that  they  completely  capture  the  true  mean  and 
covariance  of  the  prior  random  variable  x.  A  selection  scheme 
that  satisfies  this  requirement  is 

Af0  =  x,  Wo  =  n/(n  +  re) 

X i  =  x  +  (-y/ (n  +  k)p2J  ,  Wi  =  re/{2(n  +  re)}, 

i  =  1, . . . ,  n  (36) 

Xi  =  x.~  (\/ (n  +  i  Wi  =  re/{2(n  +  re)}, 

i  =  n  +  1, . . . ,  2n 

where  re  is  a  scaling  parameter  and  ^ \J (n  +  re)Pxj  is  the  ith 
row  or  column  of  the  matrix  square  root  of  (n  +  n)I\.  The 
weights  are  selected  so  that 

2  n 

5>  =  ! 

»= 0 

If  x  is  Gaussian,  then  selecting  re  such  that  (n  +  re)  =  3 
minimizes  the  mean-squared-error  up  to  the  fourth  order  [16]. 
However,  when  re  is  negative,  then  there  exists  a  possibility 


that  the  predicted  covariance  can  become  a  non-positive  semi- 
definite.  If  this  is  of  concern,  then  another  approach  can  be 
used  that  allows  for  scaling  of  the  sigma  points,  which  guar¬ 
antees  a  positive  semi-definite  covariance  matrix  [17].  Sigma 
point  are  then  propagated  through  the  nonlinear  function 

yt=h(Xi),  i  =  0, . . .  ,2n  (37) 

and  the  estimated  mean  and  covariance  of  y  are  computed  as 
follows 

2  n 

y  =  w>y>  (38> 

i= 0 

2  n 

Py  =  J2  w*  w  -  y)  -  y)T  (39> 

2=0 

These  estimates  are  accurate  to  the  second  (third  order  for 
Gaussian  priors)  of  the  Taylor  series  expansion  of  h(-)  for 
any  nonlinear  function.  Errors  introduced  in  the  higher-order 
terms  are  scaled  by  the  choice  of  the  parameter  re. 
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